Robotic Lab - Path Planning Problem - Arduino Uno